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(§) Heading detecting apparatus. 



@ A heading detecting apparatus for estimating a current heading of a moving body is described that 
individually analyzes and evaluates error factors that are respectively included in the heading data of a 
magnetic sensor and in the angular velocity data of a turning angular velocity sensor (e.g M optical fiber 
gyro, mechanical gyro, vibration gyro, gas rate gyro) and determines the rate of use of the output data of 
the turning angular velocity and magnetic sensors. 



CO 
00 



in 
o 

<L 
LU 



Jouve, 18, rue Saint-Denis, 75001 PARIS 









o 




O 








M 






9 




Cu 


as 










M 


















M 
















O 
















w 


a 


a 


PQ Q 



O H 
H J L> O 

M < > W 









0 0 


Q 
























H OO Q 









EP 0 451 988 A1 

FIELD OF THE INVENTION 

The present invention relates in general to a heading (azimuth) detecting apparatus, and in particular to 
such an apparatus which detects the heading of yawing direction of a moving body by the use of a magnetic 
5 sensor and a turning angular velocity sensor (e.g., optical fiber gyro, mechanical gyro, vibration gyro, gas rate 
gyro) for sensing the moving direction and turning angular velocity of the moving body. 

DESCRIPTION OF THE PRIOR ART 

10 As a method for providing information about the actual location of a vehicle traveling streets, aircraft navi- 
gating air routes or ship navigating sea routes, there is known "dead reckoning", in which a distance sensor, 
a heading sensor (magnetic sensor or turning angular velocity sensor) and a processing unit (e.g., computer) 
for processing distance and heading data obtained from the distance and heading sensors are employed and 
the current location data of a moving body are obtained by using an amount of distance change 81 and a heading 

15 © (case of the magnetic sensor) or amount of heading change 5© (case of the turning angular velocity sensor). 
A description of the "vehicle" will hereinafter be given, and in a case where a "travel" of the vehicle and a "navi- 
gation" of the aircraft or ship are used together, the travel" is used. In the dead reckoning method, the east-west 
directional component 6x (=5! times cos ©) and south-north directional component 5y (=8! times sin ©)of the 
distance change amount 81 that occurs as the vehicle moves along a street are calculated, and current location 

20 output data (Px, Py) are obtained by adding the calculated components 8x and 8y to the previous location output 
data (Px', Py*). However, conventional systems using dead reckoning have their disadvantages in that the 
accumulation of error occurs due to inherent limitations on the achievable accuracy of the heading sensor. 

That is to say, when the heading sensor is a magnetic sensor which senses earth magnetism for obtaining 
the absolute heading of a moving body, the magnetic sensor senses the feeble intensity of the Earth's magnetic 

25 field. Therefore, if the moving body is magnetized, an error will occur in the output data from the magnetic sen- 
sor. In order to compensate for this error, the initialization of the magnetic sensor is performed. However, when 
the moving body passes through regions including magnetic disturbance, such as railroad crossings, places 
wherein power cables are buried, iron bridges, highways with sound insulating walls and high buildings, the 
moving body is subjected to influence of the strong electromagnetic field and therefore the amount of the mag- 

30 netization of the moving body varies. For this reason, sometimes the error occurs again during traveling. There- 
fore, if the magnetic sensor output data including such magnetic disturbance is detected with accuracy and 
removed, an accurate heading of the moving body cannot be obtained. 

When, on the other hand, the turning angular velocity sensor is employed, it is known that error in the sensor 
output data will appear frequently at the time changes in the heading become more than a predetermined value, 

35 at the time the power source is turned on, at the time the vehicle travels at very slow speeds or at the time it 
is detected that the vehicle is traveling on rough roads such as mountain roads. Unless compensation for this 
error is made, the dead reckoned positions will become increasingly imprecise or inaccurate. 

Then, it has been proposed that the turning angular velocity sensor and the magnetic sensor are both used 
jointly as a heading sensor. If either the turning angular velocity sensor output data or the magnetic sensor out- 

40 put data is reduced in reliability, one data can be compensated for by the other data. 

Then, in the heading detecting apparatus, in which a current location of a moving body is obtained by read- 
ing and storing output data of the turning angular velocity and magnetic sensors and calculating the current 
heading of the moving body from those sensor output data and the previous estimated heading, a current esti- 
mated heading of the moving body can be obtained by calculating Kalman filter gain in consideration of charac- 

45 teristic errors inherently included in the output data from the turning angular velocity and magnetic sensors and 
by processing the magnetic sensor heading data and the heading data calculated from the turning angular 
velocity sensor output with a weighting processing method based on the calculated Kalman filter gain. However, 
in this method, it becomes a problem how the characteristic error components included in the output data from 
the turning angular velocity and magnetic sensors are evaluated. 

so That is to say, the individual error components are evaluated by some method and if these are set to con- 
stant values, the processing can be most easily performed. However, setting to the constant values is insuffi- 
cient because the error component in the output of the magnetic sensor is sometimes increased rapidly during 
traveling by the changes in the magnetized amount and it is desirable to evaluate the error components accu- 
rately at real time by some method. In addition, since an offset that is included in the output data from the turning 

55 angular velocity sensor varies with time, it is necessary to take into consideration the error in the turning angular 
velocity sensor data resulting from that variation. 

The inventor of the present invention has proposed a heading detecting apparatus (Japanese Patent Appli- 
cation No. 1-329851), which measures the output data from the turning angular velocity and magnetic sensors 

« 3 • 



EP0451 988 A1 



and processes them at real time and is capable of accurately estimate the current heading of a moving body 
with the aid of the data higher in reliability among the both output data from the turning angular velocity and 
magnetic sensors. In this apparatus, only a variation value that is included in the final output data from the turn- 
ing angular velocity and magnetic sensors is measured and the processing is performed in accordance with 
the measured variation value. Therefore, this apparatus does not take into consideration individual errorfactors 
that are respectively included in the output data of the turning angular velocity and magnetic sensors. 

Accordingly, it is an object of the present invention to provide a heading detecting apparatus which is cap- 
able of estimating a current heading of a moving body accurately by individually analyzing and evaluating the 
errorfactors that are respectively included in the heading data of the magnetic sensorand in the angular velocity 
data of the turning angular velocity sensor and by determining the rate of use of the output data of the turning 
angular velocity and magnetic sensors. 

SUMMARY OF THE INVENTION 

In order to achieve the above object, a heading detecting apparatus of the present invention, as shown in 
FIG. 1, comprises a turning angular velocity sensor for sensing a heading of a moving body and a magnetic 
sensor for sensing a heading of the moving body. First means (A) is connected to the turning angular velocity 
sensor for calculating an offset value that is included in an output of the turning angular velocity sensor as the 
moving body is in its stopped state and for calculating an error of the offset value. Second means (B) is con- 
nected to the first means (A) for calculating a time change rate of the offset value and an error of the time change 
rate. Third means (C) is connected to the first means (A) and to the second means (B) for calculating a current 
error that is included in the output of the turning angular velocity sensor, in accordance with the error of the 
offset value multiplied by an elapsed time after the moving body starts traveling and with the error of the time 
change rate of the offset value multiplied by the elapsed time after the moving body starts traveling. Fourth 
means (D) is connected to the magnetic sensor for calculating a magnetized amount of the moving body and 
an error of the magnetized amount from heading data outputted from the magnetic sensor under a predeter- 
mined condition as the moving body is in its traveling state. Fifth means (E) is connected to the fourth means 
(D) for calculating a change in the magnetized amount of the moving body and an error of the change from 
heading data outputted from the magnetic sensor as the moving body is in its traveling state. Sixth means (F) 
is connected to the fifth means (E) for calculating a current magnetized amount of the moving body and an error 
of the current magnetized amount in accordance with the magnetized amount of the moving body and the error 
of the magnetized amount that were calculated by the fourth means <D) and with the change in the magnetized 
amount of the moving body and the error of the change that were calculated by the fifth means (E). Seventh 
means (G) is connected to the turning angular velocity and magnetic sensors for calculating a change in a dif- 
ference between the heading data from the turning angular velocity sensor and the heading data calculated 
from the output of the magnetic sensor. Eighth means (H) is connected to the sixth means (F) and to the seventh 
means (G) for calculating anerrorthatis included in the heading outputfrom the magnetic sensor, in accordance 
with the change in the difference between the heading data from the magnetic sensor and the heading data to 
be calculated from the output of the turning angular velocity sensor that was calculated by the seventh means 
(G) and in accordance with the error of the current magnetized amount of the moving body calculated by the 
sixth means (F). Ninth means (I) is connected to the third means (C) and to the eighth means (H) for calculating 
a Kalman filter gain by calculating a reliability of each of the output data of the turning angular velocity and mag- 
netic sensors from the error in the output of the turning angular velocity sensor calculated by the third means 
(C) and from the error in the heading output data of the magnetic sensor calculated by the eighth means (H). 
Tenth means (J) is connected to the ninth means (!) for calculating a current estimated heading of the moving 
body by processing the heading data calculated from the magnetic sensor output and the heading data calcu- 
lated from the turning angular velocity sensor output with a weighting processing based upon the Kalman filter 
gain. 

The first means (A) calculates an offset value that is included in an output of the turning angular velocity 
sensor as the moving body is in its stopped state and calculates the error of the offset value. The reason why 
the data from the turning angular velocity sensor as the moving body is in its stopped state are sampled is that 
only the offset value is included in the turning angular velocity sensor output Then, the second means (B) con- 
nected to the first means (A) calculates a time change rate of the offset value and an error of the time change 
rate. By calculating the time change rate, the offset value and the error of the offset value as the moving body 
fe in its traveling state can be estimated. Then, based upon the error of the offset value multiplied by an elapsed 
time after the moving body starts traveling and upon the error of the time change rate of the offset value mul- 
tiplied by the elapsed time after the moving body starts traveling, the third means (C) connected to the first 
.means (A) and to the second means (B) calculates a current error that is included in the output of the turning 
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angular velocity sensor. This makes It possible to estimate the offset value and the offset value error at any 
time. 

Then, the fourth means (D) connected to the magnetic sensor calculates a magnetized amount of the mov- 
ing body and an error of the magnetized amount from heading data outputted from the magnetic sensor under 

5 a predetermined condition as the moving body is in its traveling state, and the fifth means (E) connected to the 
fourth means (D) calculates a change in the magnetized amount of the moving body and an error of the change 
from the heading data outputted from the magnetic sensor as the moving body is in its traveling state. The "pre- 
determined condition as the moving body is in its traveling state" is a condition that, for example, during curve 
traveling and the like, the magnetized amount of the moving body and the error of the magnetized amount can 

10 be calculated. The reason why the change in the magnetized amount of the moving body is calculated by the 
means (E) is that sometimes the magnetized amount changes when the moving body passes through railroad 
crossings, etc. 

Next, based upon the magnetized amount of the moving body and the error of the magnetized amount that 
were calculated by the fourth means (D) and upon the change in the magnetized amount of the moving body 
15 and the error of the change that were calculated by the fifth means (E), the sixth means (F) connected to the 
fifth means (E) calculates a current magnetized amount of the moving body and an error of the current mag- 
netized amount 

Then, the seventh means (G) connected to the turning angular velocity and magnetic sensors calculates 
a change in a difference between the heading data from the turning angular velocity sensor and the heading 

20 data calculated from the output of the magnetic sensor. Sometimes a difference occurs between the heading 
data from the turning angular velocity sensor and the heading data calculated from the output of the magnetic 
sensor. However, for a short term, this difference is caused by the error in the heading data of the magnetic 
sensor rather than by the error in the heading data calculated from the output of the angular velocity sensor 
and therefore is thought of as the heading data error of the magnetic sensor. 

25 In the eighth means (H) connected to the sixth means (F) and to the seventh means (G), an error that is 

included in the heading output from the magnetic sensor is calculated in accordance with the change in the 
difference between the heading data from the magnetic sensor and the heading data to be calculated from the 
output of the turning angular velocity sensor that was calculated by the seventh means (G) and in accordance 
with the error of the current magnetized amount of the moving body calculated by the sixth means (F). 

30 Then, the ninth means (I) connected to the third means (C) and to the eighth means (H) calculates a Kalman 
filter gain by calculating a reliability of each of the output data of the turning angular velocity and magnetic sen- 
sors from the error in the output of the turning angular velocity sensor calculated by the third means (C) and 
from the error in the heading output data of the magnetic sensor calculated by the eighth means (H). 

Finally, in the tenth means (J), a current estimated heading of the moving body is calculated by processing 

35 the heading data calculated from the magnetic sensor output and the heading data calculated from the turning 
angular velocity sensor output with a weighting processing based upon the Kalman filter gain. That is to say, 
according to the present invention, the current heading of the moving body can be estimated accurately by indi- 
vidually analyzing and evaluating the error factors that are respectively included in the heading data of the mag- 
netic sensor and in the angular velocity data of the turning angular velocity sensor and by determining the rate 

40 of use of the output data of the turning angular velocity and magnetic sensors. 

It is noted that in addition to the errors described above, various errors, such as an error of quantization 
and the like caused at the time of A/D conversion and errors that are normally considered, may also be adopted. 

BRIEF DESCRIPTION OF THE DRAWINGS 

45 

The features and advantages of a heading detecting apparatus according to the present invention will be 
more clearly understood from the following description taken in conjunction with the accompanying drawings: 
FIG. 1 is a block diagram of a heading detecting apparatus incorporating the principles of this invention; 
FIG. 2 is a block diagram illustrating one embodiment of the heading detecting apparatus; 
so FIG. 3 is a diagram showing how offset values of the output of the gyro of FIG. 1 are varied; 

FIG. 4 is a flow chart showing the heading detecting procedure of the apparatus of FIG. 2 for calculating 
the heading of a vehicle in accordance with the principles of this invention; and 
FIG. 5 illustrates the travel track of the vehicle that was obtained by the use of the heading detecting 
apparatus of this invention. 

55 

DESCRIPTION OF THE PREFERRED EMBODIMENT 

FIG. 2 illustrates a preferred embodiment of a heading detecting apparatus of the present invention which 
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may be employed in a vehicle navigation system. The heading detecting apparatus comprises a wheel sensor 
41 which senses the number of rotations of the left and right wheels {not shown) respectively of a vehicle (this 
sensor is used as a distance sensor which senses distances traveled by the vehicle), a magnetic sensor 42 
for sensing the heading of the vehicle, a first AJD (analog-to-digital) converter 42a connected to the magnetic 

5 sensor 42, a gyro 43 (which is selected from among an optical fiber gyro which reads a turning angular velocity 
as a phase change of interference light a vtoration gyro which senses a turning angular velocity with the aid 
of cantilever vibration technique of a piezoelectric element, a mechanical gyro, etc. This gyro 43 is uses as a 
turning angular velocity sensor which senses the heading of the vehicle), and a second A/D 43a converter con- 
nected to the gyro 43. The heading detecting apparatus further comprises a road map memory 2 for storing 

w road map data, a locator 1 which calculates an estimated heading of the vehicle in accordance with the output 
data sensed by the gyro 43 and magnetic sensor 42 and also calculates location output data of the vehicle with 
the calculated estimated heading and the data of the wheel sensor 41, a buffer memory 3 to which the result 
of the calculation is inputted from the locator 1, a data memory 6 connected to the locator 1 for storing mag- 
netized amount data that are included in the data of the magnetic sensor 42 and a dispersion of the magnetized 

15 amount data and for storing gyro offset data that are included in each data of the gyro and a dispersion of the 
gyro offset data, a navigation controller 6, a display 7 connected to the navigation controller 6 for displaying 
the read out vehicle current location on the map, and a keyboard 8 connected to the navigation controller 6. 

In the locator 1 described above, the number of rotations of the wheel is obtained by counting the number 
of the pulses outputted from the wheel sensor 41 with a counter (not shown), and travel distance output data 

20 per unit time are calculated by multiplying the count output data of the counter by a predetermined constant 
number indicative of a distance per one count Also, a relative change in the vehicle heading is obtained from 
the gyro 43. Then, based on the relative change and the absolute heading output data of the magnetic sensor 
43, the locator 1 calculates the heading output data of the vehicle, as will be described below. 

The above described road map memory 2 stores road map data of a given area in advance and comprises 

25 a semiconductor memory, cassette tape, CD-ROM, IC memory, DAT or the like. 

The above described display 7 comprises a CRT display, crystalline liquid display or the like and displays 
a road map that the vehicle is traveling and a current location of the vehicle. 

The above described navigation controller 5 is constituted by a figure processor, an image processing mem- 
ory and the like, and generates instructions to perform a retrieval of the map on the display 7, switching of scale, 

30 scrolling, a display of the vehicle current location and like. 

The above described memory 6 stores a gyro offset value Bo, a dispersion Bvo of the gyro offset, an esti- 
mated change rate m of the gyro offset a dispersion mv of a gyro offset change rate, a magnetized amount 
Mn, a dispersion value Xn 2 of the magnetized amount Mn, a magnetized amount change 5Mn, and a dispersion 
value Yn 2 of the magnetized amount change 8Mn. These values are calculated as follows. 

35 The output data 50 G of the gyro 43 and the output data 0 H of the magnetic sensor 42 are sampled every 
a constant time and the number of sampling is represented by a subscript of n. 

The output data 80 G n of the gyro 43 as the vehicle is in its stopped state is normally zero, but the output 
will appear if an offset (bias) has occurred in the gyro. The gyro offset value Bo is calculated as follows: 



AO 



Bo = 



E 60 G n 



N 



45 where N is the number of data as the vehicle is in its stopped state. Therefore, the gyro offset value Bo repre- 
sents a mean value of the gyro offset data. 

The dispersion value Bvo of the gyro offset represents the degree of fluctuation that the gyro offset value 
Bo has and can be written as follows: 

50 

dispersion of 59 n 



Bo = constant 4- 



55 The constant of the first term of the above equation corresponds to an error of quantization and the second 
term is a term relating to the number of data, that is, the time needed for sampling data If the stopped time of 
the vehicle is longer, the dispersion value Bvo of the gyro offset will become smaller. 

The estimated change rate m of the gyro offset is an amount indicative of a gradient between an gyro offset 
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value Bo(to) in time (to) immediately after the vehicle is stopped and an gyro offset value Bo(t1) in time (t1) 
immediately before the next traveling of the vehicle and is calculated as follows: 

5 Bo(tl) - Bo(to) 

Bo = 

tl - to 

FIG. 3 shows fluctuations of the gyro offset values with the offset value taken on the ordinate and with time 
10 on abscissa, and actual fluctuations of the gyro offset values are shown by the broken line. The gradient of 
estimated gyro offset values between time (to) and time (t1) is represented by reference character m. Also, the 
gradient of actual gyro offset values is represented by reference character mc. 

The dispersion mv of the gyro offset change rate is an amount corresponding to a difference between the 
estimated change rate m of the tyro offset and the actual change rate mc of the gyro offset and is given by the 
15 following equation: 

Bv(to) + Bv(tl) 
xnv = = 

20 (ti - tor 

The magnetized amount Mn can be obtained by calculating a change in the vehicle heading, which is 
caused as the vehicle turns, from the output of the gyro 43 and by calculating the center of a geomagnetism 
heading circle from this calculated heading change and from the outputs of the gyro 43 before and alter the 
25 vehicle turns (see Japanese Patent KOKAI Publication No 63-128222). 

The dispersion value Xn 2 of the magnetized amount Mn is a dispersion value that is included in the mag- 
netized amount Mn to be calculated each time the vehicle turns. 

The magnetized amount change SMn is a change in the magnetized amount as the vehicle is subjected to 
a great change of the magnetic field during traveling (the moving direction and magnitude of the center of the 
30 geomagnetism heading circle), and Yn 2 Is a dispersion value of the magnetized amount change SMn. 

If, for example, the last magnetized amount is B and a new magnetized amount is A, the magnetized amount 
change SMn is calculated by the following equation: 

SMn = kl + k2A + k3B + k4AB + k5A 2 B 2 -B 
where k1-k5 are coefficients. The coefficients k1-k5 are calculated based on data as a specific vehicle was 
35 actually magnetized. The dispersion value Yn 2 is the remainder as the coefficients k1-k5 were determined in 
the above method. 

The vehicle heading detecting procedure by the apparatus constructed as described above will hereinafter 
be described in detail. During traveling, the vehicle location and map are displayed on the display 7 in accord- 
ance with the individual sensor output data read and stored in the locator 1, but, during the display, the individual 

40 output data from the sensors are also read in and stored with an interruption at intervals of a consrant time and 
the vehicle heading is updated. FIG. 4 shows the vehicle heading detecting flow at the time of this interruption. 
It is noted that this interruption may also be made at intervals of a constant distance that is calculated based 
on the output data indicative of the distances traveled by the vehicle. The constant time or constant distance 
is suitably set, depending upon the type of turning angular velocity sensors to be used, functional performance 

45 of magnetic sensors to be used and the like. 

In step 1 , the output data 80 G n of the gyro 43 and the output data © H n of the magnetic sensor 42 are read 
in and stored. 

Next, in step 2, the gyro offset value Bo, dispersion Bvo of the gyro offset, estimated change rate m of the 
gyro offset and the dispersion mv of the gyro offset change rate are read out from the data memory 6. 
so Next, in step 3, the magnetized amount Mn, dispersion value Xn 2 of the magnetized amount Mn, mag- 
netized amount change SMn and the dispersion value Yn 2 of the magnetized amount change SMn are read out 
from the data mernory 6. The magnetized amount Mn and the dispersion value Xn 2 of the magnetized amount 
Mn are obtained only under specific conditions, such as curve traveling and the like, and the latest values are 
not always obtained during traveling. 
55 Then, in step 4, a current estimated magnetized, amount nn and the dispersion value nvn 2 are calculated 
: by the following equations: m-.- 

...»■• jin = anMn + (1-an)(Mn-1 + SMn) 
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an = 



Yn 2 + \i vn-1 2 

5 2 2 

Xri + Yri + u vn-l z 



\i\m 2 = anXn 2 

where an is a Kalman filter coefficient 
10 Then, based upon the read out individual data, a current estimated heading of the vehicle is calculated, in 
order to obtain the current estimated heading, in step 5, a dispersion qn 2 of the output data 5© G of the gyro 
43 and a dispersion rn 2 of the output data 0 H of the magnetic sensor 42 are calculated respectively by the 
foDowing equation: 

« qn 2 = qo 2 + V mv T 

where T is a time since the last stop of the vehicle, qo is an error that does not relate to the stop time and rep- 
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resented by the sum of an error of quantization and an error V B vo Qf ^ Qyro offsetj and 
-/ mv 

T is equal to an error of the gyro offset change rate times an elapsed time T since the last stop and 
becomes an error resulting from the gyro offset change. 

The dispersion m 2 of the output data 9 H of the magnetic sensor 42 is expressed by the following equation: 

rn 2 = r D 2 + r Q 2 + r L 2 + (xn 2 -an-1 2 ) + r^ 2 

where: 

r D = constant part of an error that is included in the output data © H of the magnetic sensor 42, 
r Q = quantization error = 1/(2 times geomagnetism level), 
r L = level error = 

0.7 x | geomagnetism level difference | /(estimated value of geomagnetism level), 
xn = difference between the heading data to be calculated from the output of the gyro 43 and the heading 
data of the magnetic sensor 42 = ( ©n-1 + 8©n ) - ©n", 

on-1 2 = dispersion of the last estimated heading ©n-1, 

xn 2 - an-1 2 = dispersion to be included in xn- dispersion of the last estimated heading ©n-1 = dispersion 
that is newly included in the estimated heading, and 

rim 2 = dispersion of the magnetic sensor resulting from the dispersion of the magnetized amount 
It is assumed that the various errors described above arise independently of one another, and the disper- 
sions qn 2 and m 2 are obtained by the sum of dispersion values based on the individual factors. 

In step 6, by using qn 2 and rn 2 , an estimated heading © in which errors are taken into consideration is 
calculated by the following equation: 

©n = pn©n H + (1-0n)(©n-1 + 8©n G ) 
where ©n is an estimated heading to be calculated with a new interruption, ©n-1 is the last estimated heading, 
8©n G and © H n are sensor output data that are used as a new estimated heading is calculated, and Pn is a 
variable of 0 < p < 1 and a Kalman gain. By using the last Kalman gain pn-1, pn is calculated by the following 
equation: 



Bn = 



2 2 
qii + on-l z 



The dispersion of the estimated heading is calculated by the following equation: 

an 2 = pnxn 2 

As described above, the mean and dispersion of the gyro offset estimated value, the mean and dispersion 
of the rate of change of the estimated value, the mean and dispersion of the magnetized amount to be included 
in the magnetic sensor output and the mean and dispersion of the amount of change of the magnetized amount 
are respectively calculated and stored. Then, when the estimated heading of a traveling vehicle is obtained, 
the dispersions to be included in the output data of the both sensors are respectively calculated from the stored 
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data. Based on the calculated dispersions, the individual data are processed with a weighting processing 
method. As a result, the estimated heading can be obtained with high accuracy. That is to say, according to 
the present invention, the current heading of the moving body can be estimated accurately by individually 
analyzing and evaluating the error factors that are respectively included in the heading data of the magnetic 

5 sensor and in the angular velocity data of the turning angular velocity sensor and by determining the rate of 
use of the output data of the turning angular velocity and magnetic sensors. Based on this estimated heading 
and the distance data of the wheel sensor 41, a current estimated location of the vehicle can be calculated. At 
the same time, it is a matter of course that the current estimated location of the vehicle may be corrected by a 
known map matching method, in which an estimated location is corrected by comparing it with road map data 

10 and evaluating a correlated rate between the estimated location and the road map data. 

FIG. 5 illustrates the travel track of a vehicle that was obtained with the use of the heading detecting 
apparatus described above. The vehicle was magnetized as it passed through an A point (railroad crossing). 
Thereafter, a great error was caused to occur in the geomagnetism heading because of the magnetization of 
the vehicle. Since conventional heading detecting apparatuses greatly undergo the influence of the vehicle 

15 magnetization, the vehicle track was greatly departed from the actual route traveled by the vehicle (solid line), 
as shown by the alternate long and short dash line in FIG. 5. On the other hand, in the heading detecting 
apparatus of the present invention, the vehicle track becomes as shown by the broken line. 

While the heading detecting apparatus of the subject invention has been specifically in relation to vehicles, 
it is note that it is also applicable to moving bodies such as aircraft, ships, etc. Also, While the subject invention 

20 has been described with relation to the preferred embodiment thereof, various modifications and adaptations 
thereof will now be apparent to those skilled in the art All such modifications and adaptations as fall within the 
scope of the appended claims are intended to be covered thereby. 



25 Claims 

1. A heading detecting apparatus comprising: 

a turning angular velocity sensor for sensing a heading of a moving body; 
a magnetic sensor for sensing a heading of said moving body; 
30 first means (A) connected to said turning angular velocity sensor for calculating an offset value that 

is included in an output of said turning angular velocity sensor as said moving body is in its stopped state 
and for calculating an error of said offset value; 

second means (B) connected to said first means (A) for calculating a time change rate of said offset 
value and an error of said time change rate; 
35 third means (C) connected to said first means (A) and to said second means (B) for calculating a 

current error that is included in the output of said turning angular velocity sensor, in accordance with said 
error of said offset value multiplied by an elapsed time after said moving body starts traveling and with said 
error of said time change rate of said offset value multiplied by said elapsed time after said moving body 
starts traveling; 

40 fourth means (D) connected to said magnetic sensor for calculating a magnetized amount of said 

moving body and an error of said magnetized amount from heading data outputted from said magnetic sen- 
sor under a predetermined condition as said moving body is in its traveling state; 

fifth means (E) connected to said fourth means (D) for calculating a change in said magnetized 
amount of said moving body and an error of said change from heading data outputted from said magnetic 
45 sensor as said moving body is in its traveling state; 

sixth means (F) connected to said fifth means (E) for calculating a current magnetized amount of 
said moving body and an error of said current magnetized amount in accordance with said magnetized 
amount of said moving body and said error of said magnetized amount that were calculated by said fourth 
means (D) and with said change in said magnetized amount of said moving body and said error of said 
so change that were calculated by said fifth means (E); 

seventh means (G) connected to said turning angular velocity and magnetic sensors for calculating 
a change in a difference between the heading data from said turning angular velocity sensor and the head- 
ing data calculated from the output of said magnetic sensor; 

eighth means (H) connected to said sixth means (F) and to said seventh means (G) for calculating 
55 an error that is included in the heading outputfrom said magnetic sensor, in accordance with said change 

in the difference between the heading data from said magnetic sensor and the heading data to be calculated 
from the output of said turning angular velocity sensor that was calculated by said seventh means (G) and 
in accordance with said error of the current magnetized amount of the moving body calculated by said sixth 
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means (F); 

ninth means (I) connected to said third means (C) and to said eighth means (H) for calculating a 
Kalman filter gain by calculating a reliability of each of the output data of said turning angular velocity and 
magnetic sensors from said error in the output of said turning angular velocity sensor calculated by said 
third means (C) and from said error in the heading output data of said magnetic sensor calculated by said 
eighth means (H); and 

tenth means (J) connected to said ninth means (I) for calculating a f cuirent estimated heading of said 
moving body by processing the heading data calculated from the magnetic sensor output and the heading 
data calculated from the turning angular velocity sensor output with a weighting processing based upon 
said Kalman filter gain. 

2. A heading detecting apparatus as setforth in claim 1 , wherein said predetermined condition as said moving 
body is in its traveling state is a condition that for example, during curve traveling and the like, said mag- 
netized amount of the moving body and said error of the magnetized amount can be calculated. 

3. A heading detecting apparatus as setforth in claim 1, wherein said moving body is a vehicle. 
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FIG. 2 
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FIG.3 
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FIG. 4 



c 



HEADING DETECTION 



) 



READ AND STORE 69 G n AND G H n 



READ OUT 

Bo, Bvo, in AND mv 
FROM DATA MEMORY 



READ OUT 




Mn, Xn 2 , 6Mn AND Yn 2 


FROM DATA 


MEMORY 



CALCULATE \m AND p. vn 



CALCULATE 
qn 2 OF GYRO DATA 
AND rn 2 OF MAGNETIC 
SENSOR DATA 



CALCULATE 6 



c 



RETURN 



3 



14 



EP 0 451 988 A1 




15 



EP 0 451 988 A1 



4 



European Patent 
Office 



EUROPEAN SEARCH REPORT 



Application Number 



EP 91 30 2675 



DOCUMENTS CONSIDERED TO BE RELEVANT 



Category 



Citation of document with mdkatitD, where appropriate 
of relevant passages 



Relevant 
to daim 



CLASSIFICATION OF THE 
APPLICATION (Int. CL5) 



D,A 



GB-A-2 216 272 (NISSAN) 

Figure 2; abstract; claim 1 * 

EP-A-0 268 278 (SUMITOMO) 
* Figure 3; abstract * 



6 01 C 21/20 
G 01 C 17/38 



The present search report has been drawn up for all claims 



TECHNICAL FIELDS 
SEARCHED (Int. CL5) 



G 01 C 



Place of seartb 

THE HAGUE 



Date d cot^JetSoa of tte search 

05-07-1991 



K0LBE W.H. 



CATEGORY OF CITED DOCUMENTS 

X : particularly relevant if taken alone 

Y : particularly relevant H combined with another 

document of the same category 
A : technological background 
O : non-written disclosure 
P : intermediate document 



T : theory or principle underlying the invention 
E : earlier patent document, but published on, or 

after the filing date 
D : document cited in the application 
L : document cited for other t 



& : member of the same patent family, corresponding 



16 



